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A NONLINEAR, SIX-DEGREE OF FREEDOM, 
PRECISION FORMATION CONTROL ALGORITHM, 
BASED ON RESTRICTED THREE BODY DYNAMICS 

Richard J. Luquette* and Robert M. Sanner t 

Precision Formation Flying is an enabling technology for a variety of 
proposed space-based observatories, including the Micro- Arcsecond X-ray 
Imaging Mission (MAXIM), the associated MAXIM pathfinder mission, 
and the Stellar Imager. An essential element of the technology is the 
control algorithm. This paper discusses the development of a nonlinear, 
six-degree of freedom (6DOF) control algorithm for maintaining the 
relative position and attitude of a spacecraft within a formation. The 
translation dynamics are based on the equations of motion for the 
restricted three body problem. The control law guarantees the tracking 
error convergences to zero, based on a Lyapunov analysis. The simulation, 
modelled after the MAXIM Pathfinder mission, maintains the relative 
position and attitude of a Follower spacecraft with respect to a Leader 
spacecraft, stationed near the L2 libration point in the Sun-Earth system. 


INTRODUCTION 

Distributed Spacecraft Systems (DSS) represent the future architecture for 
constructing very large, space- based observatories. 1 Widely varying science goals lead to an equal 
assortment of design concepts and requirements. Stellar Imager, 2 the Micro- Arcsecond X-ray Imaging 
Mission (MAXIM), 3 and the associated MAXIM Pathfinder, represent a subset of missions requiring 
precision formation flying. The spacecraft are expected to be stationed at the Earth-Sun L2 point, 
or in a Earth drift-away orbit about the Sun. In both cases the Restricted Three Body Problem 
(RTBP) provides a natural context for design and analysis of the formation control law. Mission 
success will depend on the development of many supporting technologies. 

One essential technology element is the algorithm for both relative position and attitude control. 
Traditionally, spacecraft control algorithms treat the orbital dynamics and attitude dynamics as 
uncoupled. However, precision formation flying requires continuous low thrust to achieve a sub- 
millimeter mission design criteria. Continuous thruster action introduces a coupling action between 
orbital trajectory control and attitude control. With proper design the thrusters can serve as 
actuators to simultaneously control the spacecraft orbit and attitude trajectories. Implementation 
of this control strategy requires a six-degree of freedom (6DOF) control law. This paper proposes a 
6DOF nonlinear control law to solve this problem building on previous work of the authors, which 
focused on the 3DOF, orbital control problem. 4,5 
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Figure 1: Two Spacecraft Formation Orbiting in the Earth/Moon - Sun Rotating Frame 

Refer to the Notation section at the end of this paper for definitions of mathematical symbols not 
provided as part of the discussion. 

PROBLEM STATEMENT 

Consider a two spacecraft formation stationed in the vicinity of L2 in the Earth/Moon - Sun 
rotating frame, as shown in Figure 1. The spacecraft designations are Leader and Follower. The 
Earth-Moon system is modelled as a combined mass located at the system center of mass. The 
position and relative motion of the Earth/Moon system and the Sun define the rotating frame. 
The Leader maintains a planned ballistic trajectory with periodic station- keeping maneuvers, and 
a predetermined attitude trajectory. Attitude control on the Leader is accomplished with reaction 
wheels to avoid perturbing its orbit trajectory. The Follower tracks a specified separation trajectory, 
Xd, relative to the Leader, and a predetermined attitude trajectory, q^. Measurement data provides 
the relative position and velocity between the two spacecraft. Each spacecraft is equipped to measure 
attitude, referenced to an inertial coordinate frame. The Follower is equipped with thrusters to serve 
as actuators for both translation and attitude maneuvers. 

The problem: 

• Design a control algorithm for the Follower to track a desired trajectory, Xd and qd . 

• Demonstrate the tracking error approaches zero, at least asymptotically. 

• Characterize the stability properties, i.e. local versus global stability. 

SYSTEM DYNAMICS AND KINEMATICS 

This section provides a brief review of both the dynamics and kinematics of translation and rotation 
for a spacecraft. 

Translation 

The following analysis is extracted from Refs. 4 and 5. Given a spacecraft stationed near the 
Sun-Earth/Moon L2 point, the principle environmental forces are gravity and solar pressure. These 


forces, combined with thruster action, drive the spacecraft dynamics. The principal gravitational 
sources are the Sun and the Earth-Moon system. In comparison, the mutual gravitational interaction 
between the spacecraft is insignificant. Based on the reference vectors shown in Figure 1, the Leader 
dynamics (per unit mass) are given bv Eq. (1). The Follower dynamics per unit mass are given by 
Eq. (2). 
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The relative motion of the Follower with respect to the Leader is computed as the difference of Eqs. 
(1) and (2). 
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The terms are arranged to resolve the main gravitational forces into three components along the 
vectors, x, r EL , and r SL . The typical formation under consideration represents a space-based 
observatory. Therefore, the desired, xa, is assumed constant in magnitude and direction with respect 
to inertial space. On the short time scale for control the spacecraft position will remain essentially 
fixed in the rotating frame, Figure 1. Therefore, the gravitational component along x, remains 
constant in inertial space, except during reorientation. The other components remain constant in 
the rotating frame of the RTBP. Theoretically, the magnitude and direction of these terms could be 
computed based on the position of the spacecraft relative to the Earth, Sun and other gravitational 
bodies, allowing direct compensation for the gravitational gradient between spacecraft in the control 
design. However, in practice precise position data is not available for spacecraft stationed at L2, or a 
heliocentric drift away orbit. Therefore, knowledge of the magnitude and direction of these terms is 
considered unknown. So, with ©i and ©2 representing the unknown constant vectors in the inertial 
and RTBP frames, respectively, Eq. (3) can be expressed as: 
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As a further simplification, the perturbing forces due to solar pressure and other gravitational 
sources are also modelled as unknown, constant components, one inertially fixed, the other fixed in 
the RTBP frame. The assumption is reasonable. Solar pressure acts along the spacecraft to sun 
line, which is fixed in the RTBP rotating frame. As with the Sun and Earth/Moon, the contribution 
of other gravitational sources can be resolved into two components, one in each of the inertial and 
RTBP frames. These components also remain essentially constant under the stated assumptions. 
Therefore, the terms, Af olar and Af p . rt , are absorbed into the terms, ©j and © 2 - Then, Eq. (4) 
is rewritten as: 
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Rotation 

The equation for rotational dynamics of a rigid spacecraft without reaction wheels is given by: 

H ft - S([ H r * w]) *< 

where: S([H R * u>]) is the skew symmetric matrix formed 1 
In general, the rotational kinematics are given by: 
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CONTROL LAW DESIGN 

The proposed control law design combines algorithms for control of translation from Ref. 5, and 
rotation from Ref. 6. 
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Translation 

The control design is based on nonlinear adaptive theory developed for robotic applications. 7 Under 
the assumption that Eq. (5) represents the relative dynamics, Ref. 4 presents an adaptive control 
strategy that provides globally stable, perfect tracking of a desired smooth trajectory for a spacecraft 
with a known mass. The analysis assumes perfect knowledge of the motion of the Follower with 
respect to the Leader. Terms used in the following discussion are defined as: 

m F - Mass of Follower 

m F - Estimated Mass of Follower 

Xd - Desired spacecraft separation vector 



© T - Estimate value of 0 T 
© T - (0 T — © x ) 

x r - (xd-A T * (x — Xd)), reference velocity 

s T - (x - Xd) + A x * (x - Xd) = X - x r , error metric 

a - Design parameter, adaptive gain, positive constant 

K t - Design parameter, symmetric, uniformly positive definite matrix 

A t - Design parameter, constant, symmetric, positive definite matrix 

The proposed control law for differential thrust per unit mass is: 
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For a spacecraft of known mass, Eqs. (5) and (8) combine to form the expression for the tracking 
error dynamics: 
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The error dynamics, Eq. (10), combined with the adaptive rule, Eq. (9), results in exponentially 
stability of the tracking error. The proof is provided by Ref. 4. 

With the additional restriction that the desired acceleration, x d = 0, ref. 5 extends this result, 
demonstrating that the above algorithm is still valid for a spacecraft with uncertain mass. For a 
spacecraft of unknown/estimated mass, Eqs. (5) and (8) combine to form the expression for the 
tracking error dynamics: 
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Where the error metric is redefined as, s' T = ( x - x d ) -f <x * A * ( x — Xd), with a — ^ £L . Further, 
define © T = a * © r — © T . Then Eq. (11) is rewritten as: 

( x - x d ) + <r * A * ( x - xa) = * (a * ® T — © T ) — (1 — a) * x d - K t * , 

K = r T *© T -K T * s ;-(i-a)*x d [ } 

Under the stated assumption, x d = 0, the error dynamics are simplified as: 

*; = r T * ® T - k t * s; (13) 

Coupled with the following modified adaptive rule the equations assume the same form as Eqs. (8) 
and (9). 
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Exponential stability of the tracking error is directly inferred from the Lyapunov proof presented in 
Ref. 4. Also, © T — * 0, which implies © T — ► ^© T , versus © T . 

As a final note, the modified adaptive rule and error metric, s^, facilitate the proof of exponential 
stability. As the value of a is unknown, it cannot be directly factored into the algorithm design. 
However, the control law provided in Eq. (8), combined with the adaptive rule, Eq. (9), are sufficient 
to generate the desired result. Effectively, the term, (cr * A), is treated as a single design parameter 
for defining s^. . 

Rotation 

Ref. 6 presents a passivity-based attitude control algorithm for a rigid spacecraft. The formulation 
for a spacecraft with gas jet actuators is applied to this design. Terms used in the following discussion 
are defined as: 

u>d - Desired Spacecraft Angular Rate 

q d = [e d r)d] T - Desired Spacecraft Attitude Quaternion 
q - [if}] = q® q^ 1 , error quaternion 

u> T - (t Od — A T * e), reference angular rate 

s a - (oj — u> r ), angular rate error metric 

K a - Design parameter, symmetric, uniformly positive definite matrix 

A a - Design parameter, constant, symmetric, positive definite matrix 



Based on the rotational dynamics, Eq. (6), the control law is defined as: 


r == H r * — S([H R * u>]) * — K a * s R (15) 

Implementation of this algorithm requires knowledge of the spacecraft moment of inertia, H R , 
which is limited by measurement errors and mass property variations. Therefore, an adaptive 
control strategy, designed to estimate the mass properties, is preferred. This is accomplished by 
reformulating Eq. (15) as: 
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Where: 


r R (q,w,av,w r ) * © R = H r * d> r - S([H r * u>]) * w r (17) 

The matrix, T R (q, w, u> r , w r ), contains the known rigid body dynamics and kinematics. The vector, 
0 R , contains the mass properties, considered constant and unknown. The control, Eq. (16), 
combined with the adaptive rule, Eq. (18), provides global convergence of the tracking error to 
zero. 6 
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Combined 


Simultaneous implementation of the above control algorithms requires coordinated thruster action to 
generate the desired translation and rotation control inputs. The relationship between the thruster 
output and the net control inputs is expressed as: 
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where: 

b U - Combined, translation and rotation control in body coordinates 
R(q) - Transformation from inertial to body coordinates 
B - Control sensitivity matrix 
F - Thruster output, [fi , h , • * • , fn] T 

With proper placement of the thrusters the control sensitivity matrix, B, will have a pseudo inverse. 
Then, the thruster commands are computed as: 


F = B T (B*B T )- 1 * b U 


( 20 ) 


This implementation for computing thruster commands generates the desired thrust and torque for 
translation and rotation control. Therefore, the convergence and stability properties of the previously 
discussed algorithms are retained, and further analysis/proof is not required. 



SIMULATION 


The performance of the control design is demonstrated through a simulation based on the MAXIM 
Pathfinder mission. The spacecraft are initialized in an orbit about the L2 point in the Earth/Moon- 
Sun system. The leader spacecraft remains on a ballistic trajectory, u thriwt L = 0. The scenario 
starts with the Follower at the same position and attitude as the Leader, i.e. initial deployment. 
The Follower tracks a command trajectory to a 200 km separation, Fig. 2, while simultaneously 
tracking a 90 degree slew maneuver, Fig. 3. The simulation is implemented in MATLAB©. 

The successful controller performance is evidenced by the tracking error, shown in Figs. 4 and 5. 
The controller gains are not designed for optimal performance. 



Figure 2: Desired Relative Separation between Follower and Leader 



Figure 3: Euler Angle of Desired Attitude, qa, of Follower with Respect to Inertial 





Figure 4: Relative Position Trajectory Tracking Error, (x — Xd) 



Figure 5: Euler Angle of Quaternion Trajectory Tracking Error, (q® q^) 

CONCLUSIONS AND FUTURE WORK 

This paper presents a successful adaptive, nonlinear 6DOF formation control strategy for spacecraft 
experiencing slow changes in environmental forces, typical for an orbit about L2. Adaptation is employed 
to estimate the spacecraft mass properties. Stellar Imager, MAXIM and MAXIM Pathfinder are typical 
missions with potential for employing this strategy. 

The development assumes the availability of perfect measurement data. Further thruster performance is 
ideal. Future work will consider issues associated with corrupted measurement data, and issues associated 
with thruster alignment and performance, and coupled stability issues with an observer/estimator. 




NOTATION 


Symbols for additional terms are defined in the following table. All vectors are resolved in inertial 
coordinates, unless otherwise stated. 
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- Force exerted on spacecraft due to solar pressure 

- Force exerted on spacecraft due to other perturbations 

- Force exerted on spacecraft due to thrusters 

- Identity Matrix, 3x3 

- Rotation Matrix from Inertial to Earth/Moon - Sun Rotating Frame 

- Gravitational parameter of the Earth/Moon 

- Gravitational parameter of the Sun 

- Spacecraft Moment of Inertia 

- Spacecraft Angular Rate 

- External Torque on Spacecraft 

- Spacecraft Attitude Quaternion 

- Vector Component of Spacecraft Attitude Quaternion 

- Scalar Component of Spacecraft Attitude Quaternion 

- Skew-symmetric matrix of vector, S(v) * w, equivalent to cross product, v x w. 
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